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ABSTRACT 

The importance of RobotArms (Serial Manipulators) is increasing rapidly in the last few years in space, 
industrial and medical applications. An important part of Robot Arms is to achieve desired pose (position and orientation), 
in order to accomplish this very good knowledge of inverse kinematics is needed. Getting a solution to Inverse kinematics of 
the Robot Arms has been considered as a mature problem which is thoroughly researched and is also on the focus of 
various research and developments in Robotics field. SSRMS (a redundant manipulator) has total 7 revolute joints. They 
can be structured as shoulder joints, elbow joints and wrist joints (end effector). This paper presents biologically-inspired 
Genetic Algorithms (optimization) approach for solving Inverse kinematics problem of SSRMS. In this paperGA solver 
from MATLAB’s (optimization toolbox) is used to find the joint angles of SSRMS robot , solver parameters such as 
population size, elite count , crossover fraction, etc. are selected to achieve maximum performance resulting in optimum 
joint variables. 
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1. INTRODUCTION 

Robotic systems will play an increasingly important role in future space activities, such as repairing, 
refueling, re-orbiting, assembling and upgrading spacecraft [ 1-51 . ASSRMS(Canadarm2) has seven joints, each 
joint has a large movement range of +270°[6] and links have offset lengths to avoid any mechanical interference. 
The joints are subjected tothe functions ofcontrollers, sensorsand actuators. Resolving Position level Inverse 
kinematics of SSRMS is notsimilar to solving Inverse kinematics of Industrial manipulator which has 6 degrees of 
freedom, where a spherical wrist (three adjacent joints) is attached to the end effector. The joints of SSRMS are 
structured like this. Shoulders are connected by three joints, two large boom like links (lower and upper arms) are 
connected by one elbow joint. Three joints connect the Wrist which holds end-effector.In the current approach, the 
Forward kinematics equations (trigonometry) which will give a target point (X t , Y t , Z t ) are written in Fitness 
Function. Travelling Salesman Problem (TSP) from combinatorial optimization, domain, is considered for 
minimizing the position error. With the given set values (constraints) GA solver (MATFAB’s optimization 
toolbox) returns the optimum joint angles for SSRMS.The relationship between inverse kinematics and 
direct/forward kinematics can be seen in Figure 1. 
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Figure 1: Relationship between Forward and Inverse Kinematics 


2. FORWARD KINEMATICS 

Given joint link parameters of a robot determining its configuration (position and orientation) of every link using 
rigid motion method are Forward kinematics [7]. Link (i) connected to joint (i) and joint (i+1), to get the kinematic 
information of all the links by attaching a coordinate frame to each link (i) at joint (j + 1) is known as Denavit-Hartenberg 
method. 



Figure2:Link(i) Connected to Joint (i) and Joint (i + 1) 

SSRMS end effector pose can be obtained from the Homogeneous Transformation Matrix (T). 

T = T x x T 2 x T 3 x T 4 x T s x T 6 x T 7 

The Forward kinematics can be given by multiplication of individual transformation matrices 
Ti,T 2 T 3 ? T 4 5 T 5 5 T 65 T 7 aredefined in Table 1. 
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Given the configuration of a robot determining joint variablesassociated with the links is Inverse kinematics (IK). 
Finding the elements of vector [qj for the given transformation °T n 


°T n =°T 1 (q 1 )x 1 T 2 (q 2 ) x 2 T 3 (q 3 ) x'-'T./q,,) 

[qiq 2 q 3 ....q n ] 

Where n E[ 1 j ] 

Inverse kinematics problem can be decoupled in to rotation matrices and translation matrices. 


°T 7 =°T 3 x 3 T 6 x 6 T- 



4. CONFIGURATION OF SSRMS MANIPULATOR 

SSRMS has total 7 re volute joints, they are 

• Shoulder joints(J 1J2J3). 

• Elbow joint ( J4 ). 

• Wrist joints (J5J6J7). 

D-H frames, joints and configuration of SSRMS is shown in Figure 3and Figure 4. 



Figure3: CAD Model of SSRMS with7 Joints and 
DH-Frames(Base to End-Effector) 
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Figure4: Configuration of SSRMS Manipulator 
(Zero Displacement) with7 Joints and DH-Frames 


Table 1: SSRMS Forward Kinematics Transformation Matrices 


Rotation Matrices 

Translation Matrices 

T 1 = 

(c(0 x ) 0 -s(6>) 0 > 

s(6>) 0 c(0 t ) 0 

0-10 -d x 

V 0 0 0 1 i 

\ 

/ 


t 2 = 

(c{0 2 ) 0 -s(0 2 ) 0 N 

s(0 2 ) 0 c{0 2 ) 0 

0-1 0 d 2 

V 0 0 0 1 ) 



t 3 = 

/ c(0 3 ) -s(0 3 ) 0 a 3 xc(0 3 )\ 
s(0 3 ) c(0 3 ) 0 a 3 x s(0 3 ) 

0 0 0 d 3 

\ 0 0 0 1 / 


t 4 = 

(c{0 A ) -s(<9 4 ) 0 a 4 xc(0 4 )\ 
s(0 4 ) c(0 4 ) 0 a 4 xs(0 4 ) 

0 0 1 d 4 

\ o oo i / 


t 5 = 

fc(0 5 ) 0 s(0 5 ) 0\ 

s(0 5 ) 0 -c(0 5 ) 0 

0 1 0 d 5 

0 0 0 1 / 
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/c(A) 0 -s(0 6 ) 0 \ 

t _'s(6>) 0 c(* 6 ) 0 

0-10 d 6 

0 0 0 1 / 



c(0 7 ) -s(0 7 ) 0 0\ 

t _ s(0 7 ) c(0 7 ) 0 0 

0 0 1 d 7 

0 0 0 1 / 


5. GENETIC ALGORITHMS (GA) 


GA[8] and TSP is used for joint angle optimization in this study. Since GA is a meta heuristics algorithm, the 
results do not guarantee an exact optimal solution, but they give near optimal solutions. GA is good at navigating through 
larger search spaces, where locating a local-minima and applying mutation resulted in a very effective solution.In this 
study joint angles of SSRMS are derived using the methodologies applied for TSP using GA. If (PX, P y , P z ) is denoted as a 
known point, the first step is determining the location of the target point (X t , Y t , Z t ) for path planning. Forward kinematics 
equations written in fitness function will give the target point location, the second step is to achieve global optimum by 
minimizing the distance between the target and known location. Constraints on joint angles (Lower and Upper bounds) will 
minimize GA search space, increasing the possibility of obtaining optimum joint angles in a smaller number of 
generations. The number of generations has been set to 200.When an average change infunction fitness value becomes less 
than the function tolerance 10e-6, GA stops the optimization in this case. Peter Corke’s Robotics Toolbox for 
MATLAB[9]is used to visualize graphical SSRMS robot. 



Figure5: Graphical Robot Representation of SSRMS 
using Robotics Toolbox for MATLAB 

5.1 GA Flow Chart for Finding SSRMS Joint Angles 

GA flow chart for finding optimum joint angles for SSRMS robot configuration. 
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Figure 6: Flowchart for Finding Optimum Joint Angles Using GA 


Table 2: D-H Parameters of SSRMS (7DOF) 


Frame 

ai [Link Length] 

a j [Link Twist] 

di [Link Offset] 

0i [Joint Angle] 

1 

0 

-ai 

di 

0i 

2 

0 

-02 

d 2 

^2 

3 

a 3 

0 

d 3 

03 

4 

a 4 

0 

d 4 

04 

5 

0 

a 5 

d 5 

05 

6 

0 

-06 

d 6 

06 

7 

0 

0 

d 7 

0? 
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System (SSRMS) Using Genetic Algorithms 

5.2 Forward Kinematics Equations of SSRMS 

Xt = a 4 c 4 (Sjs 3 + C!C 2 C 3 ) - d 2 S! - d 6 (c 5 (c 4 (c 3 S! - C!C 2 s 3 ) - s 4 (sjs 3 + C!C 2 c 3 )) - s 5 (c 4 (sjs 3 + CiC 2 c 3 ) + s 4 

(C 3 S 1 - CiC 2 s 3 ))) - d 7 (s 6 (c 5 (c 4 (S 1 S 3 + CiC 2 c 3 ) + s 4 (c 3 Si - CiC 2 s 3 )) + s 5 (c 4 (c 3 Si - CiC 2 s 3 ) - s 4 (sis 3 + CiC 2 c 3 ))) + CiC 6 s 2 ) + a 4 s 4 

(c 3 Sj - C!C 2 s 3 ) - Cid 3 s 2 - Cid 4 s 2 - C!d 5 s 2 + a 3 S!S 3 + a 3 C!C 2 c 3 ; 

Yt = cid 2 + d 7 (s 6 (c 5 (c 4 (cis 3 - c 2 c 3 Si) + s 4 (cic 3 + c 2 sis 3 )) + s 5 (c 4 (cic 3 + c 2 S!S 3 ) - s 4 (cis 3 - c 2 c 3 si))) - c 6 sis 2 ) + d 6 (c 5 (c 4 (cic 3 + 
c 2 SjS 3 ) - s 4 (Cis 3 - c 2 c 3 S!)) - s 5 (C 4 (C!S 3 - c 2 c 3 S!> + s 4 (Cjc 3 + c 2 S!S 3 ))) - a 4 c 4 (c t s 3 - c 2 c 3 S!> - a 4 s 4 (c^ + c 2 SiS 3 ) - a 3 C!S 3 - d 3 SjS 2 - 
d 4 SiS 2 - d 5 SiS 2 + a 3 c 2 c 3 Si; 

Zt = di - d 6 (c 5 (c 3 s 2 s 4 + c 4 s 2 s 3 ) + s 5 (c 3 c 4 s 2 - s 2 s 3 s 4 )) - c 2 d 3 - c 2 d 4 - c 2 d 5 - d 7 (c 2 c 6 - s 6 (c 5 (c 3 c 4 s 2 - s 2 s 3 s 4 ) - s 5 (c 3 s 2 s 4 + c 4 s 2 s 3 ))) 

- a3C3S2 + a4S2S3S4 - a4C3C4S2; 

Here c n = cos(0n) here n = 1 to 7 

s n = sin(0n) here n = 1 to 7 

Here a 3 = 7.110, a 4 = 7.110, = 0.380, d 2 = 1.360, d 3 = 0.570, d 4 = 0.475, d 5 = 0.570, d 6 = 0.635, 

d 7 = 0, a, = - 71 / 2 , a 2 = - 7i/2, a 3 = 0, a 4 = 0, a 5 = 7i/2, a 6 = - 7i/2, a 7 = 0. 


5.3Forward Kinematics Equations Written in Fitness Function(Fitfcn)of GA Solver 


xt = a4 * (cos (min (4))) * ( (sin (min (1))) * (sin (min (3))) + (cos (min (1))) 

* (cos (min (2))) * (cos (min (3))) ) — d2 * (sin (min (l))j — d6 

* ( (cos (min (5))) * ( (cos (min (4))) * (( cos (min (3))) * (sin (min (1))) 

— (cos (min (1))) * (cos (min (2)}) * (sin (min (3))) ) — (sin (min (4))) 

* ( (sin (min (1))) * (sin (min (3))) + (cos (min (1))) * (cos (min (2))) 

* (cos (min (3))) )) - (sin (min (3))) * ( (cos (min (4))) * ((sin (min (1))) 

* (sin (min (3))) + (cos (min (1))) * (cos (min (2))) * (cos (min (3))) ) 

+ (sin (min (4))) * ((cos (min (3))) * (sin (min (1))) — (cos (min (1))) 

* (cos (min (2))) * (sin (min (3))) ))) — dl * ((sin (min (6))) 

* ((cos (min (5))) * ((cos (min (4))) * ((sin (min (1))) * (sin (min (3))) 

+ (cos (min (1))) * (cos (min (2))) * (cos (min (3))) ) + (sin (min (4)}) 

* ( ( cos (min (3))) * (sin (min (1))) - (cos (min (1))) * (cos (min (2))) 

* (sin (min (3))) )) + ( sin (min (5))) * ( (cos (min (4))) * ( ( cos (min (3))) 

* (sin (min (1))) — (cos (min (1))) * (cos (min (2))) * (sin (min (3))) ) 

— (sin (min (4))) * ((sin (min (1))) * (sin (min (3))) + (cos (min (1)}) 

* (cos (min (2))) * (cos (min (3))) ))) + (cos (min (1))) * (cos (min (6))) 

* (sin (min (2))) ) + a4 * (sin (min (4))) * (cos (min (3))) 

* (sin (min (1))) — (cos (min (1))) * (cos (min (2))} * (cos (min (3))) 

— (cos (min (1))) * d3 * (sin (min (2))} - (cos (min (1))) * d4 

* (sin (min (2))) — (cos (mm(l))) * dS * (sm(mm(2))) + a3 

* {sm(mm(l))) * (sin(min(3))) + a3 * (cos(mm(l))) * (cos(mm(2))) 

* (cos(mm(3)}) ; 


yt = (cos(mm( 1))) * d2 + dl * ((sin (min (6))) * ( (cos(mirc(5))) * ( (cos(min(4))) 

* ((c£?s(min(l))) * (sm(min(3)J) — (cas(mm(2))) * (eos(mm{3))) 

* (sm(min(l))) ) + (x in (mm. (4))) * ( (cos (min (1))) * (cos(min(3))) 

+ (cos(mirc(2))) * (sin(mfn(l))) * (sin(mm(3))) )) + (sm(wiin(5))) 

* ( (cos(mm(4))) * ( (cos(min(l))) * (cos(mm{3))) + (ccs(??iin(2))) 

* (sm(min(l))) * (sin(min(3)))) — (sm(m£n{4))) * ((cos(mm(l))) 

* (sm(min(3))) — (cos(mm(2))) * (cos(?mn(3))) * (sm(mm(lj))))) 

— (cos(mtn(6))) * (sin(m£n.(l))) * (sin(min(2)))) + d6 * ( (cos(mm{5))) 

* ((cas(min(4))) * (cos(mm(l))) * (cos(min(3))) + (cos(mm(2))) 

* (siji(min(l))) * (sin(min(3))) ) — (sin (mira(4))) * ( (cos(mm{l))) 

* (sin(min{3))) — (cos(rram(2))) * (cos(min(3))) * (sm(mm(l))) ) 

— (sm(min(S))) * ((cos(mm(4))) * ( (cos(mm(l))) * (sin(min(3))) 

— (cos(mm(2))) * (cos(mm(3))) * (sm(min(l)))) + (sin(m:n(4))) 

* ((cos(min(l))) * (cos{min(3)y) + (cos(m£n(2))) * (sm(min(l)J) 

* (sin(min(3))) ))) — a4 * (cos(min( 4))) * ( (cosfmm(l))) * (sin(mm(3))) 

— (cos (min(2))) * (ca5(mm(3))) * (sifi(min{l)))) — a4 * (sm{min(4))) 

* ((cos(mm(l))) * (cos(mm(3))) + (cos(min(2))) * (sm(m£n(l))) 

* (sm(m£n(3))) ) — a3 * (cos(min{ 1))) * (sin(mm{3))) — * (sm(min(l))} 

* (sm(min(2))) — dA * {s£n(min(l)J) * (sm(mm(2))) — dS * (sin(mm(l))) 

* (sin(min(2))) + a3 * (cos(mm(2))) * (cos(mm(3))) * (sin{wun(l))); 
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st = dl — d6 * ((coj(mm(S))) * {(cos(mm(3))) * (sm(mm(2))) * (sin(mm(4))) 

+ (coj(min(4))) * (sm(min(2))) * (sin{mm(3)))) + (fm[min{5))) 

* ( (cos(mm(3))) * (cos(mm(4))) * (sm(min(2))) — (sm(min(2))) 

* (siti(mm(3))) * (sm{min(4))) ) — (ccs(mm(2))) * cf3 — (cos(mm(2))} 

* — (cos(min(2))) * dS — dl * ( (cos(mm(2))) * (cos(min(6))) 

— (sm(min(6))3 * {(cos(mm(S))) * ((cos(mm{3))) * (cos(mm{4))) 

* (sm(mm(2))) — (sm(min(2))) * (sm(mm(3))) * (sm(mm(4)))) 

— (sm(mm(S))) * ((cos(mm.(3))) * (sm(min{2))) * (sm(mm(4))) 

-t (cos(mm{4))) * (sm(wun(2))) * (sin(mjn(3)))))) — «3 * (cos(min(3))} 

* (sm(mm(2))) + ti4 * (sm{min(2))} * (sm(mni(3))) * (sin(min(4))) 

— a4 * (cos(min(3))) * (cos(min(4))) * (sm(mm(2)))); 


5.4Positioning Error 

The ordinary straight-line distance between two points(Euclidean distance),in this case the distance between target 
point and the known point in the 3-D space, so the positioning error is given as, 

Pmin = E - ~p2 + ~ ~Py )2+(z < - ~pJ 2 

7=1 

GA solver with required input parameters and return values. 

[theta, fval, flag, output] = ga(Fitfcn, nvars, [],[],[],[], LB, UB, [ ], options); 

6. RESULTS 

Giventask points. 

Pj = [ Px = 1.25; py = 2.32; pz = 2.41;] 

P 2 = [p x = 1.38; py = 2.22; pz = 1.21;] 

As there are 7 unknown joint angles, each joint angle is considered to be of 4-bit length, Initial GA population has 
7 x 4= 28 genes. GA will apply Selection, Crossover and Mutation operators on 28 binary strings(chromosomes)for 
creating the next generation. With the given set values,the chromosomesare randomly changed, and GA will generate 
better joint angles in every generation, which refers to reaching given task points by minimizing the positioning error and 
increased accuracy. 


Table 3: Joint Angles for given Task Points 


S.No 

0x[rad] 

0 2 [rad] 

0 3 [rad] 

0 4 [rad] 

0 5 [rad] 

0 6 [rad] 

0 7 [rad] 

Pi 

2.453 

0.187 

-0.149 

2.449 

0.263 

-1.212 

2.212 

P 2 

0.724 

0.334 

0.424 

1.342 

-0.664 

-0.661 

0.617 
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Fitness Vs Generation 



Figure 7: Fitness Vs Generation (Objective Function Evaluation for Joint Angles) 


Table 4: GA Options (Set Values) 


S.No 

(GA) Set Values 

Value 

1 

Population 

200 

2 

Mutation Rate 

0.01 

3 

Crossover fraction 

0.8 

4 

Elite Count 

0.05 x Population 

5 

LB 

Joint angle lower bounds 

6 

UB 

Joint angle upper bounds 

7 

nvars 

7 

8 

Options 

Graphs(Fitness Vs Generation) etc. 

9 

Fitfcn 

Fitness/objective function 


Table 5: GA OUTPUT(Get Values) 


S.No 

OUTPUT(GA) Get Values 

Value 

1 

Generations 

51 

2 

Function-count 

10400 

3 

Best Fitness 

4.016 

4 

Mean Fitness 

4.01065 


7. CONCLUSIONS 

In this paper the GA andTSP combinatorial optimizationsare used to find the join angles of SSRMS, The output 
(joint angles) returned by GAfromgiving operating points (P h P2) is accurate, when the Upper bound (UB) and Lower 
bound (LB) is set on a heuristic basis, The time taken for solving 1 set of joints is 0.9 seconds, when the search space is not 
constrained withLB and UB on joint angles the time taken is 25 minutes. Joint angles obtained from GA are used with 
Robotics Toolbox for MATLAB for visualization of SSRMS robot. Finding Optimized trajectory for a given task is in the 
future scope of this work. 
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